#pragma config(Hubs,  S1, HTMotor,  HTMotor,  HTMotor,  HTServo)
#pragma config(Sensor, S1,     ,               sensorI2CMuxController)
#pragma config(Motor,  mtr_S1_C1_1,     motorD,        tmotorNormal, openLoop, encoder)
#pragma config(Motor,  mtr_S1_C1_2,     motorE,        tmotorNormal, openLoop, encoder)
#pragma config(Motor,  mtr_S1_C2_1,     motorF,        tmotorNormal, openLoop)
#pragma config(Motor,  mtr_S1_C2_2,     motorG,        tmotorNormal, openLoop)
#pragma config(Motor,  mtr_S1_C3_1,     motorH,        tmotorNormal, openLoop)
#pragma config(Motor,  mtr_S1_C3_2,     motorI,        tmotorNone, openLoop)
#pragma config(Servo,  srvo_S1_C4_1,    servo1,               tServoStandard)
#pragma config(Servo,  srvo_S1_C4_2,    servo2,               tServoContinuousRotation)
#pragma config(Servo,  srvo_S1_C4_3,    servo3,               tServoContinuousRotation)
#pragma config(Servo,  srvo_S1_C4_4,    servo4,               tServoStandard)
#pragma config(Servo,  srvo_S1_C4_5,    servo5,               tServoNone)
#pragma config(Servo,  srvo_S1_C4_6,    servo6,               tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

#include "ballhoop definitions.h"
task main()
{
nNxtExitClicks = 1;
servo[servo1] = CLAMP_HOME;
servo[servo2] = 127;//stop crate lift
servo[servo3] = 127;//stop   "   spin

motor[motorD] = 100;
motor[motorF] = 10;
wait10Msec(100);
//while (nNxtButtonPressed != kLeftButton)
//{
//nxtDisplayTextLine(0, "%d", nMotorEncoder[motorD]);
//}

motor[motorF] = 100;
motor[motorD] = 10;
wait10Msec(100);
// while (nNxtButtonPressed != kLeftButton)
// {
// nxtDisplayTextLine(0, "%d", nMotorEncoder[motorD]);
// }


motor[motorF] = 0;
motor[motorD] = 0;

motor[motorG] = 100;
motor[motorE] = 10;
wait10Msec(100);
// while (nNxtButtonPressed != kLeftButton)
// {
// nxtDisplayTextLine(0, "%d", nMotorEncoder[motorE]);
// }


motor[motorE] = 100;
motor[motorG] = 10;
wait10Msec(100);
// while (nNxtButtonPressed != kLeftButton)
// {
// nxtDisplayTextLine(0, "%d", nMotorEncoder[motorE]);
// }


motor[motorE] = 0;
motor[motorG] = 0;

motor[motorH] = 100; // conveyor
wait10Msec(100);
// while (nNxtButtonPressed != kLeftButton)
// {}

motor[motorH] = 0;


}
